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Abstract — In  this  paper  we  address  the  problem  of  distributed 
tracking  with  consensus  on  a  time-varying  graph  with  incomplete 
data  and  noisy  communication  links.  We  develop  a  distributed 
and  collaborative  tracking  with  consensus  algorithm  by  com¬ 
bining  distributed  Kalman  filtering  with  consensus  updates  to 
handle  a  time-varying  network  topology  in  which  not  every  node 
has  local  observations  to  generate  own  local  tracking  estimates. 
We  introduce  the  concepts  of  active  node  set  and  connectivity 
graph  to  characterize  such  a  network,  and  by  merging  these 
two,  an  effective  network  graph  is  obtained.  Simulation  results 
and  performance  analysis  of  the  proposed  algorithm  are  given 
and  compared  with  that  of  distributed  local  Kalman  filtering 
with  centralized  fusion. 

I.  Introduction 

Distributed  consensus  estimation  in  sensor  networks  has 
gained  considerable  attention  in  recent  years  [1],  The  problem 
has  been  studied  with  both  fixed  as  well  as  time  varying 
communication  topologies,  taking  into  account  issues  such 
as  link  failure,  packet  losses,  quantization  noise  or  additive 
channel  noise  [2]— [5] .  Recent  work  in  [4],  [6],  [8]  have  also 
considered  the  distributed  consensus  tracking  over  networks 
with  noiseless  communication  links  among  nodes. 

Distributed  tracking  with  consensus,  addressed  in  this  paper, 
refers  to  the  problem  that  a  group  of  nodes  need  to  achieve  an 
agreement  over  the  state  of  a  dynamical  system  by  exchanging 
tracking  estimates  over  a  network.  For  instance,  space-object 
tracking  with  a  satellite  surveillance  network  could  benefit 
from  distributed  tracking  with  consensus,  due  to  the  fact  that 
individual  sensor  nodes  may  not  have  enough  observations 
of  sufficient  quality  and  different  sensor  nodes  may  arrive  at 
different  local  estimates  regarding  the  same  space  object  of 
interest  [6],  Information  exchange  among  nodes  may  improve 
the  quality  of  local  estimates  and  help  avoids  conflicting  and 
inefficient  decisions.  Other  examples  include  flocking  and 
formation  control,  real-time  monitoring,  target  tracking  and 
GPS  systems  [6],  [7], 

In  this  work,  we  consider  the  problem  of  distributed  tracking 
with  consensus  on  a  time-varying  graph  with  incomplete  data 
and  noisy  communication  links,  where  the  time-varying  graph 
consists  of  fixed  nodes  that  are  connected  together  and  mobile 
nodes  that  have  active  links  with  other  nodes  only  within  their 
communication  radii.  We  develop  a  framework  by  combining 
distributed  Kalman  filtering  with  consensus  updates  to  handle 
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a  time-varying  network  topology  in  which  not  every  node  has 
local  observations  to  generate  own  local  tracking  estimates 
(incomplete  data).  We  introduce  the  concepts  of  an  active  node 
set  and  a  connectivity  graph  to  characterize  such  a  network. 
By  merging  the  active  node  set  with  the  connectivity  graph, 
an  effective  network  graph  is  obtained. 

Following  notation  will  be  used  in  this  paper:  At  time  k, 
an  undirected  graph  is  denoted  by  G(k)  =  (V,E(k)),  where 
V  =  1,2 ,■■■  ,n  and  E(k)  C  V  x  V  for  k  >  0.  The 
neighborhood  of  node  i  at  time  k  is  denoted  by  flj(fc)  = 
{(  e  £  E(k)}.  Node  i  has  degree  di(k)  =  |fij(fe)|. 

Let  the  degree  matrix  at  time  k  be  the  diagonal  matrix 
D(k)  =  diag(di(fc),  •  •  •  ,dn(k)),  where  diag(di,  •  •  •  , dn) 
represents  a  diagonal  matrix  with  di,---  ,dn  on  its  main 
diagonal.  The  adjacency  matrix  at  time  k  is  A(k)  =  \Au{k)], 
Aiifk)  =  1,  if  ( i ,  l )  £  E(k),  0  otherwise.  The  graph  Laplacian 
matrix  is  L(k)  =  D{k)  —  A{k).  The  Laplacian  is  a  positive 
semidefinite  matrix  so  that  its  eigenvalues  can  be  ordered  as 
0  =  Ai(i))  <  \2(L)  <  ■■  ■  <  A n(L).  For  a  connected  graph, 
A2(L)  >  0  [5],  We  will  use  the  notation  G(n,p)  to  denote 
a  random  graph  with  n  vertices,  in  which  each  edge  is  taken 
randomly  and  independently  with  probability  p  £  (0,1]. 

II.  Problem  Formulation 
A.  System  Model 

Consider  an  n-node  sensor  network  with  a  connectivity 
graph  G(k)  =  ( V,E(k ))  at  time  k.  Assume  that  the  graph 
G(k)  is  undirected  and  time-varying  due  to  relative  motion 
or  battery  constraints  of  nodes.  The  objective  is  to  perform 
distributed  tracking  of  a  target  state  that  is  modelled  as  a  linear, 
finite-dimensional  system  [9] 

x(k  +  1)  =  Fx(k)  +  u(k);  x(0)  ~  J\f(x(0),  P0),  (1) 

where  x(0)  £  Rw  is  the  initial  state  of  the  target  assumed  to 
be  Gaussian  distributed.  The  sensing  model  of  the  ith  sensor 
is 

y  l(k)  =  Hlx(k)+Mk);  y,eRM,  (2) 

where  yfk)  represents  the  z-th  node’s  measurement  for  1  < 
i  <  n  and  we  assume  that  the  Hfs  can  be  different  for 
each  node.  Both  u(fc)  and  \i(k)  are  zero-mean  white  Gaussian 
noise  (WGN).  The  statistics  of  the  process  and  measurement 
noise  are  given  by  E[u(/c)u(/c')T]  =  Qdkk1,  E[v.;(fc)vi(£;,)r]  = 
RiSkk'Su,  where  5kk'  =  1  if  k  =  k!  and  Skk'  —  0,  otherwise. 

At  the  end  of  the  fc-th  tracking  update  step,  node  i  which  has 
an  observation  of  the  target  will  have  a  filtered  local  estimate 
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Xi(k\k)  with  associated  covariance  matrix  Pj(fc|fc).  In  order 
to  improve  the  consistency  of  its  estimate  against  those  of  the 
other  nodes,  node  i  will  exchange  this  filtered  estimate  with 
other  nodes  over  noisy  communication  links.  Due  to  time- 
varying  topology  of  the  network,  at  any  given  time  k  not 
all  nodes  may  observe  the  target.  These  nodes  will  not  have 
filtered  local  tracking  estimates.  Note  that,  here  the  goal  is  to 
obtain  a  consensus  tracking  estimate  over  the  local  estimates 
at  each  k,  and  thus,  the  consensus  problem  is  essentially  a 
problem  of  consensus  estimation. 


FornodeieSj! 


the  k-th  tracking  update 

Fig.  1.  Block  diagram  of  distributed  tracking  with  consensus  on  a  time-varying 
graph  with  incomplete  data  and  noisy  communication  links. 

Figure  1  shows  the  system  model  of  distributed  tracking 
with  consensus  on  a  time-varying  graph  with  incomplete  data 
and  noisy  communication  links.  Let  xT(fc, j)  denote  the  node 
i’s  updated  tracking  estimate  at  the  j-th  consensus  iteration 
that  follows  the  fc-th  tracking  update  step  with  x.;(fc,  0)  = 
Xi{k\k).  The  received  data  at  node  i  from  node  l  at  iteration  j 
can  be  written  as  z i:i(k,j)  =  xi(k,  for  0  <  j  <  J, 

where  w denotes  the  receiver  noise  at  the  node  i  in  receiv¬ 
ing  the  estimates  of  node  l  at  iteration  j  with  E[w,;y(j)]  =  Oat 
and  E[Wi,j(j)w£j(j)]  =  z iti(k,j)  =  Xi(k,j)  and  J  is  the 

number  of  iterations  in  each  consensus  update  cycle. 
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Fig.  2.  Connectivity  graph  and  effective  network  graph. 

B.  Network  Model 


We  define  the  active  node  set  SJ  in  a  time-varying  graph 
G{j)  as  the  set  of  nodes  that  have  local  estimates  to  be  shared 
with  others  at  the  beginning  of  the  j-th  consensus  iteration 
[6].  Define  the  effective  network  graph  G(j)  =  (V (j),  E(j)) 
of  a  network  G(j)  with  active  node  set  T?-7  as  a  graph  G(j) 
with  the  outgoing  edges  of  the  nodes  that  do  not  have  data 
removed.  Note  that,  the  nodes  that  do  not  observe  the  target 
will  not  have  filtered  estimates  to  share  at  the  beginning  of 
consensus  update  process.  However,  as  information  exchange 
among  nodes  progresses,  some  of  these  nodes  may  be  able 
to  form  their  own  local  estimates  to  be  shared  with  others  at 


the  beginning  of  iteration  j  for  j  >  0.  Therefore,  the  active 
node  set  S J’  is  time-varying  and  is  a  function  of  S'7-1  and 
G{j  —  1).  Figure  2  shows  the  relation  between  the  connectivity 
graph  G{j)  and  the  effective  network  graph  G(j)  for  a  graph 
of  6  nodes  with  active  node  set  S 7  =  (1,  2,4,  6),  where  solid 
circles  denote  active  nodes. 

Let  I gj  denote  an  n  x  n  diagonal  matrix  generated  from  the 
active  node  set  S1  ,  where 


1  if  i  =  i'  and  i'  £  S'-7 
0  else 


(3) 


By  combining  the  connectivity  graph  G{j)  and  active  node 
set  S-7,  we  obtain  the  effective  network  graph  G(j)  for 
j  >  0.  The  adjacency  matrix  of  the  effective  network  graph 
is  A  (j)  =  A(j)Igj.  The  corresponding  degree  matrix  D(j) 
can  then  be  generated  from  the  A  (j),  leading  to  the  Laplacian 
matrix  L(j)  =  D(j)  -  A  (j). 


III.  Distributed  and  Collaborative  Tracking  with 
Consensus  Algorithm 


For  the  above  distributed  tracking  problem  over  a  time- 
varying  graph  with  incomplete  data  and  noisy  communication 
links,  we  propose  a  distributed  and  collaborative  tracking  and 
consensus  algorithm  which  is  based  on  the  architecture  that 
was  first  proposed  in  [6].  At  the  fc-th  tracking  update  step,  node 
i  is  assumed  to  observe  the  target  and  passes  its  observation 
y i(fc)  through  a  Kalman  filter  as  follows  [9]: 


Xj(fc|fc  -  1) 

A(fc|fc-1) 

Kk 


Fxi (fc  -  l|fc  -  1), 

FPi(k-l\k-l)FT +  Q, 

Pi(k\k  -  l)HT(HiPi(k\k  -  1  )HT  +  Ri)-1, 


Xj(fc|fc)  =  Xj(fc|fc  -  1)  +  Kk(ji{k)  -  HiXi{k\k  -  1)), 

P(k\k)  =  (I-KkHi)Pi(k\k-l),  (4) 


where  Xj(fc— l|fc— 1)  =  Xj(fc— 1,  J)  with  Xj(— 1,  J)  =  x(0)  and 
Pi(k—  l|fc—  1)  =  Pi(k—  1,  J)  with  Pj(— 1,  J)  =  Pq.  Denote 
P(k  —  1  ,j)  as  the  covariance  matrix  in  the  j-th  consensus 
iteration  after  the  (fc—  l)-th  tracking  update.  The  P i{k—  1,  J) 
in  (4)  can  be  obtained  by  extracting  the  i-th  TV  x  N  main 
diagonal  block  of  P(fc  —  1,  J).  Then,  node  i  will  have  its 
filtered  estimate  x,(fc|fc)  in  tracking  update  and  uses  it  as  initial 
estimate  for  consensus  update  exchange  by  setting  x;(fc,0)  = 
x,(fc|fc)  with  initial  covariance  matrix  P(fc,  0)  =  Pi(fc|fc)  © 
p2(k\k)  ©  •  •  •  ©  Pn(fc|fc),  where  ©  denotes  the  direct  sum  of 
matrices.  For  nodes  i  £  (S°)c,  it  will  only  have  its  predicted 
estimate  x,(fc|fc  —  1)  and  Pj(fc|fc  —  1)  from  the  Kalman  filter 
in  (4)  without  observation.  It  may  arbitrarily  set  Xj(fc|fc)  =  0 
and  Pj(fc|fc)  =  eljv  for  some  e  >  0  and  use  them  as  the  initial 
estimate  for  the  consensus  stage. 

During  the  j-th  consensus  update,  each  node  i  forms  its 
consensus  estimate  by  combing  received  noisy  estimates  from 
its  neighbors  [5]: 


x,(fc,  j  +  1) 

n 

=Xi(fc,  j)  +7i(j)^Ai);(j)(zM(fc,  j)  -zM(fc,  j)),  (5) 

1  =  1 


where  7 ;(j)  is  the  i-th  node’s  weight  coefficient  at  iteration  satisfies  ((A(j) 0 IN)  -')(1  0  /.y)  =  0.  From  this,  it  follows 

j.  We  set  7 j(j)  =  7(7)  for  i  £  S J  and  7,; (j )  =  — a“7(7)  that  the  unbiasedness  in  consensus  estimate  X(k,  j)  requires 

for  i  £  ( Sj)c  and  E"=i  £  °-  Here  (5)  is  distributed  0  is  an  eigenvalue  of  the  Laplacian  matrix  L (j)  with  the 

average  consensus  with  imperfect  communication,  where  each  associated  eigenvector  1.  Similar  results  on  the  unbiasedness 

sensor  receives  noise  corrupted  versions  of  its  neighbors’ states  of  the  consensus  estimate  was  obtained  in  [6].  Then,  it  can 

and  the  weight  coefficient  is  different  for  each  node  [5],  easily  be  seen  that 


xi(k-llk-l)=xi(k-l,J)  Xj(k,0)=Xi  (klk)  Xj(klk)=3(k,J)  Xjtk+l.O^tk+lIk+l) 

Pj  (k- 1  Ik- 1  )=T?  (k- 1 ,  J)  Pi(k,0)=Pi  (klk)  Pi(klk)=Pi(k,J)  Pj(k+l,0)=f|  (k+llk+1) 


Xi(k-llk-l) 

itj(klk) 

Xj(k,0) 

Xi(kJ) 

Xj(klk) 

Xj(k+llk+l) 

Pi(k-llk-l) 

fijlklk) 

Pi(k,0) 

P.(k,J) 

Pi  (klk) 

Pi  (k+llk+1) 

the  k-th 

J 

consensus  updates 

the  (k+l)-th 

tracking  update  tracking  update 

Fig.  3.  Timing  diagram  of  tracking  and  consensus  updates  in  the  proposed 
algorithm  for  distributed  tracking  with  consensus. 

Let  X(k,j)  =  [xi  {kJ)T  x2(k,  j)T  ■  ■ -xn(k,  j)T]T .  Then, 
the  consensus  update  dynamics  can  be  written  in  vector  form 
as  follows: 

X(k,j  + 1)  (6) 

=x(fc,  j)  -  [(r(j)L(j))  0  iN]x(k,j)  -  (m  ®  /iv)w(j), 

where  T{j)  =  diag(7i(j),  72(7),  •  •  •  ,  7n(j))>  w *(7)  = 

-ELiMiK/C?)  and  W(j)  =  [wiOr,---  ,w„(j)T]T 
Define  e(k.  7)  as  the  error  vector  in  the  y-th  consensus  iteration 
that  follows  the  k- th  tracking  update:  e(k,j)  =  X(k,j)  —  (10 
Ipf)x(k).  From  (6),  it  follows  that 

e(fc,  j  +  1)  =  (A  (7)  0  IN)e(k,j )  -  ( T(j )  0  /at)W(j)  (7) 
+  ((A(j)  0  In)  —  /)  (1  0  /jv)x(fc), 

where  A(j)  =  —  Note  that,  this  coefficient  matrix 

A  (j)  is  slightly  different  from  the  one  in  [6],  In  [6],  A(j)  = 
'y(j)L(j),  where  I(j)  and  L(j)  are  the  modified  identity 
and  Laplacian  matrices. 


Fig.  4.  A  time-varying  graph  with  switching  topologies. 

Assume  that  the  filtered  estimate  x,j(fc|A;)  at  the  end  of  the 
measurement  update  stage  is  an  unbiased  estimate,  so  that 
Xi(k,  0)  is  unbiased  for  i  £  S°.  From  (5),  for  i  £  ( S' ■7)c, 
we  have  Xi(k,j  +  1)  =  y:?=X,iU)  EL + 
w,j(j)).  Then,  Xi(fc,  j  +  1)  is  unbiasedforz  £  ( S •5)c  if  x;(fc,j) 
is  unbiased  for  l  £  S1 .  From  (7)  the  unbiasedness  in  the 
consensus  estimate  X(k,j)  can  be  maintained  if  matrix  A  (j) 


P(k,j  +  1)  =  (A (j)  0  IN)P(k,j)(A(j)  0  In)t  (8) 

+  E{(r(j)  0  In)  W(i)W(i)T(r(i)  0  INf}. 

After  J  consensus  iterations,  each  node  i  feeds  Xi(k,J) 
back  to  the  Kalman  filter  by  setting  Xi(k\k)  =  %(k ,  J)  with 
covariance  matrix  Pi(k\k)  =  Pi(k,J)  before  starting  the 
next  tracking  update  for  k  +  1.  Figure  3  shows  the  timing 
diagram  of  tracking  and  consensus  updates  process  in  the 
proposed  distributed  and  collaborative  tracking  with  consensus 
algorithm,  summarized  in  Algorithm  1. 


Algorithm  1  Distributed  and  Collaborative  Tracking  with 
Consensus  Algorithm 
Initialize:  x(0),  F,  Hi,  Q,Rt 
while  new  data  exists  do 

Kalman  filtering  in  tracking  process: 

Xi(k\k  —  1)  =  Fxi(k  —  l|Jfe  —  1) 

Pz(k\k  -  1)  =  FPl{k  -  1| k  -  1  )FT  +  Q 

Ki(k)  =  Pi(k\k-l)Hf  (HiPi(k\k-l)Hj  FRi)-1 

Xi(k\k)  =  Xi(k\k—l)+Ki(k)(yi(k)—HiXi(k\k—l)) 

Pi{k\k )  =  (I-  Ki(k)Hi)Pi(k\k  -  1) 

update  the  initial  state  of  consensus  process: 

Xi(k,  0)  xj(k\k) 

P(k,  0)  ■<—  Pi(k\k)  0  P2(k\k)  0  ■  ■  ■  0  Pn(k\k) 

j  0 

while  7  <  J  —  1  do 

Xi(k,j  +  1)  =  xi(k,j)  +  'y(j)  E?=i  - 

z i  i(k,j )) 

P(k,j  +  1)  =JA 01®  IN)P(k,j)(A(j)  0  In)t  + 

mm  ®  ^)w(j)w(j)T(r(j)  ®  in)t} 
j<-j+ 1 

end  while 

Xi{k\k)  =  x_i(k,  J) 

Pi{k\k )  =  Pi(k ,  J) 
k  £-  k  +  1 

end  while 


IV.  Numerical  Examples 

In  this  section,  we  consider  the  performance  of  the  dis¬ 
tributed  tracking  with  consensus  algorithm  and  compare  it 
with  the  distributed  local  Kalman  filtering  with  centralized 
fusion,  in  which  all  nodes  send  the  filtered  estimates  to  a 
fusion  center,  and  the  fusion  center  generates  a  fused  estimate 
Xfusion(fc)  =  Eieso  Xi(fc|fc).  The  assumed  parameters  in 
the  first  simulation  setup  are  as  follows:  F  =  1,  Q  =  1, 
z(0)  =  0,  P0  =  0,  Hi  =  1,  Rj  =  0.25,  =  E  =  0.01, 

n  =  6,  J  =  30  and  S°  =  {1,3,4, 6}.  Figures  5-6  show 
the  performance  of  the  proposed  distributed  tracking  with 
consensus  on  a  time-varying  graph  with  switching  topologies. 


Fig.  5.  Node  consensus  estimates  Xi(k,J)  over  a  graph  with  switching 


Fig.  6.  Node  estimates  Xi(k,j)  and  variance  of  the  node  estimates  during  the 
consensus  updates. 


The  topologies  of  the  graph  are  described  in  Fig.  4,  where 
to  =  0, 1,2,  As  can  be  seen  for  Fig.  5,  the  proposed 
algorithm  ensures  that  all  nodes  very  closely  follow  the  target 
trajectory.  Note  that,  the  filtered  estimate  X\(k\k)  is  plotted 
for  node  1  £  S°  and  the  predicted  estimate  X2(k\k  —  1)  is 
also  plotted  for  node  2  £  (S'0)0.  Moreover,  Figs.  6  shows  that 
indeed  the  consensus  algorithm  helps  bring  local  estimates 
closer  within  very  few  exchanges  even  in  the  presence  of  noise. 

In  the  second  simulation,  we  consider  a  random  connectivity 
graph  G(n,p)  with  n  =  50  and  the  probability  that  each 
link  exists  p  =  0.5.  The  probability  of  each  node  having 
an  observation  at  a  given  time  instant  is  ps  =  0.9.  The 
other  parameters  of  the  simulation  setup  are  as  follows  [8]: 


F  =  I2  +  eFn 


£  t?  2 

T^o 


Fo  = 


0  -2 
2  0 
=  5,  x(0)  =  [15,  — 10]T 


,  e  =  0.015, 

Hi  =  [1,0] 


Q  =  (ec^)2/2,  cn 

for  i  is  odd  and  Hi  =  [0,1]  for  i  is  even,  Ri  =  c2y/i  for 
i  =  1,  •  •  •  ,  n  with  cv  =  30,  E iti  =  E  =  0.01,  J  =  10.  Figure 
7  shows  the  node  estimates  (trajectory)  of  the  two  algorithms 
in  this  time-varying  graph  with  incomplete  data.  As  we  can 
see,  the  proposed  algorithm  performs  almost  the  same  as  the 
local  Kalman  filtering  with  centralized  fusion.  In  Fig.  7,  the 


solid  curve  denotes  the  target’s  trajectory  and  the  dashed  curve 
denotes  the  distributed  local  Kalman  filtering  with  centralized 
fusion. 


Fig.  7.  Comparison  of  the  proposed  distributed  tracking  with  consensus 
algorithm  with  local  Kalman  filtering  with  centralized  fusion  (trajectory). 


V.  Concluding  Remarks 

In  this  paper,  we  developed  a  distributed  and  collabora¬ 
tive  tracking  with  consensus  algorithm  to  achieve  distributed 
tracking  in  a  sensor  network  with  incomplete  data  and  a 
noisy  time-varying  graph.  Our  simulation  results  showed  the 
proposed  algorithm  improves  the  estimation  quality  of  each 
node  and  its  performance  is  close  to  distributed  local  Kalman 
filtering  with  centralized  fusion.  The  proposed  algorithm  does 
not  require  global  knowledge  of  network  topology  and  shows 
an  advantage  in  scalability  and  robustness  to  dynamic  changes 
of  the  network  topology,  which  is  preferable  in  practical 
applications. 
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